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Local and Distributed Rendezvous of Underactuated 

Rigid Bodies 

Ashton Roza, Manfredi Maggiore, Luca Scardovi 


Abstract —This paper solves the rendezvous problem for a 
network of underactuated rigid bodies such as quadrotor he¬ 
licopters. A control strategy is presented that makes the centres 
of mass of the vehicles converge to an arbitrarily small neighbor¬ 
hood of one another. The convergence is global, and each vehicle 
can compute its own control input using only an on-board camera 
and a three-axis rate gyroscope. No global positioning system is 
required, nor any information about the vehicles’ attitudes. 


I. Introduction 


Consider a network of flying robots, each propelled by 
a thrust vector and endowed with an actuation mechanism 
producing torques about three orthogonal body axes —see 
Figure [T] With six degrees-of-freedom and four actuators, each 
robot is underactuated with degree of underactuation two. A 
quadrotor helicopter is an example of such a robot. Suppose 
each robot mounts a camera and an inertial measurement unit 
(IMU) that includes a three-axis rate-gyroscope, so that the 
robot is able to measure, in the coordinates of its own frame, 
the relative displacements and velocities of nearby vehicles, 
and its own angular velocity. The rendezvous control problem 
is to get the robots to move to a common location using only 
the above on-board sensors. To this day, this problem is open. 
This paper presents the first solution. 

Consider now n > 2 robots. The rendezvous control prob¬ 
lem investigated in this paper is to And feedback laws making 
the relative distances and velocities become arbitrarily small 
for alH, j G {1,..., n}, and for arbitrary initial conditions of 
all robots. Crucial in the problem statement is the requirement 
on sensing. If robot i can sense robot j, then robot i can 
sense the relative position and velocity of robot j in its 
own local frame. Robot i can also measure its own angular 
velocity in the coordinates of its body frame. Robot i can 
neither access its own inertial position and velocity, nor its 
own attitude. A feedback law satisfying the above sensing 
requirements is referred to as being local and distributed. 
In this paper, the set of vehicles that robot i can sense is 
assumed to be constant. This assumption is questionable in 
practice, but is made to render the problem mathematically 
treatable. The rendezvous problem with distance-dependent 
neighbors remains a challenging open problem for much 
simpler classes of robot models, such as double-integrators. 



Fig. 1. Vehicle class under consideration. 

The block diagram of the proposed controller is depicted 
in Figure |2] There are two nested loops. The outer loop 
treats each robot as a point-mass driven by a force input, 
and produces a double-integrator consensus controller which 
becomes a reference input for the inner loop. The inner loop 
assigns local and distributed feedbacks for the robots. More 
intuition is provided in Section |V] 

Besides having a simple expression making its real-time 
implementation feasible, the proposed controller meets the 
sensing requirements of the rendezvous control problem. In 
particular, it does not require any knowledge of the robots’ 
absolute positions and velocities, or of their attitudes. It does 
not even require sensing of the relative attitudes. Finally, the 
controller does not require any communication among robots. 

Our main result, Theorem [T] states that the proposed 
controller does indeed solve the rendezvous control problem, 
and in so doing it effectively reduces the problem to one of 
consensus for double-integrators. The latter problem has been 
researched extensively in the literature (e.g., Cl, El, El). 

A. Related work 

Typical coordination problems include attitude synchroniza¬ 
tion, rendezvous, flocking, and formation control. For net¬ 
works of single or double-integrator systems, the rendezvous 
problem is referred to as consensus or agreement, and it has 
been investigated by many researchers, for instance Cl, El, 

0, a, a, 0, Q, 0. 

A passivity-based solution of the attitude synchronization 
problem for kinematic vehicle models is proposed in a. 
In cni, d, C2i, the same problem is investigated for 

This research was supported by the National Sciences and Engineering 
Research Council of Canada. 

The authors are with the Department of Electrical and Com¬ 
puter Engineering, University of Toronto, 10 King’s College Road, 
Toronto, ON, M5S 3G4, Canada, ashton. roza@mail. utoronto . ca, 
maggiore@ece.utoronto.ca, scardovi@scg.utoronto.ca 





2 



{xi,v,,,Ri,ujl) 




Fig. 2. Block diagram of the rendezvous control system for robot i. The outer loop assigns a desired thrust vector The inner loop thrust control uses 

to assign the vehicle input Ui while the rotational control uses to assign the torque input Ti. The vector y? contains the relative displacements 

and velocities of vehicles that robot i can sense, measured in the body frame of robot i. 


dynamic vehicle models. The proposed controllers do not 
require measurements of the angular velocity, but they do 
require absolute attitude measurements. In ifTSl . the authors 
use the energy shaping approach to design local and distributed 
controllers for attitude synchronization. The same approach 
is adopted in IfT^ to design two attitude synchronization 
controllers, both local and distributed. The first controller 
achieves almost-global synchronization for directed connected 
graphs. However, the controller design is based on distributed 
observers ca, and therefore requires auxiliary states to be 
communicated among neighboring vehicles. It also employs an 
angular velocity dissipation term that forces all vehicle angular 
velocities to zero in steady-state. The second controller in 1141 
does not restrict the hnal angular velocities, and does not 
require communication, but it requires an undirected sensing 
graph, and guarantees only local convergence. 

The rendezvous problem for kinematic unicycles was solved 
in ifThll using time-varying feedbacks. The papers fTh), iflTll . 
ca, im discuss the feasibility of achieving various forma¬ 
tions using local and distributed feedback for kinematic unicy¬ 
cle models. Dynamic unicycle models are considered in ll20ll . 
ED. In II 20 I . a two-mode formation control is presented in 
which the sensing graph has a spanning tree with a designated 
leader vehicle as the root. Each vehicle, however, has access 
to the acceleration of the leader through communication. 
The control strategy requires a switch between two control 
modes designed to deal with nonholonomic constraints in the 
system. The paper ll2Tll presents a local and distributed control 
law making dynamic and kinematic unicycles converge to a 
common circle whose centre is stationary and dependent on the 
initial configuration of the vehicles. The spacing and ordering 
of unicycles on the circle is also controlled. The problem 
is solved using a three step hierarchical control based on a 
reduction theorem for the stabilization of sets. 

The case of kinematic vehicles in three-space is investigated 
in ifTSll . EH, ES, EH- The authors of ifTSll . ll^ consider 
the problem of full attitude and position synchronization, but 
assume fully actuated vehicles. In E4ll . the authors propose 
distributed controllers to stabilize relative equilibria which, 
as shown in ESI, ESI, correspond to parallel, circular or 
helical formations. Finally, in EtI . ESl the authors consider 
formation control for dynamic, underactuated vehicle models. 
However, the feedbacks are not local and distributed. Also, 
in ESl the sensing graph is assumed to be undirected, and 


communication among vehicles is required, while in EtI the 
graph is balanced, and it is assumed that each vehicle has 
access to the thrust input of its neighbors, therefore requiring 
once again communication between vehicles. Both approaches 
in ED, El use a two-stage backstepping methodology in 
which the first stage treats each vehicle as a point-mass 
system to which a desired thrust is assigned. A desired 
thrust direction is then extracted and backstepping is used 
to design a rotational control such that vehicle rendezvous 
or formation control is achieved. Our previous work E9l 
investigates almost-global vehicle rendezvous making use of 
a two-stage hierarchical methodology similar to EtI . El . In 
this approach, one can combine a consensus controller for a 
network of double-integrators and an attitude tracking con¬ 
troller satisfying certain assumptions to produce a rendezvous 
controller for underactuated vehicles. However, this approach 
requires that all vehicles can sense a common inertial vector in 
their own body frame, which requires additional on-board sen¬ 
sors. Moreover, the approach requires communication among 
vehicles. The solution presented in this paper overcomes all 
these limitations. To the best of our knowledge, a solution 
to the rendezvous control problem for underactuated flying 
vehicles stated earlier has not yet appeared in the literature. 

B. Organization of the paper. 

We begin, in Section m by introducing some notation and 
presenting basic notions of homogeneity of functions and 
stability of sets. In Section HII] we review the vehicle model. 
In Section |IV] we formulate the rendezvous control problem. 
The main result. Theorem [D is presented in Section [V] and 
its proof in Section [VI] In Section I VIII we present simulation 
results showing that the proposed solution is robust against 
measurement errors, as well as force and torque disturbances. 
Finally, in Section IVIIIl we end the paper with some remarks. 
The proof of the main result relies on two technical lemmas 
that are proved in the appendix. 

H. Preliminaries and notation 

We denote by Kq. the set of positive real numbers. We use 
interchangeably the notation v =\vi ■ ■ ■ or (vi,... ,Vn) 
for a column vector in R”. We denote by 1 G R” the vector 
(1,..., 1). If ri, w are vectors in R^, we denote by v-w := 
their Euclidean inner product (also called the dot product). 
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and by ||ii|| := (v ■ the Euclidean norm of u. If u = 

(vx,Vy,Vz), we define 

0 

:= Vz 0 

-Vy Vx 

One has that v^w = v x w. Let { 61 , 62 , 63 } denote the 
natural basis of and S0(3) := {M G : M~^ = 

M^,det(M) = 1}. If r is a closed subset of a Riemannian 
manifold X, and diA’xA’—>'[0,oo)isa distance metric 
on X, we denote by ||xl|r := infi/)6r d(X) V”) the point-to-set 
distance of x S A" to E. If 6 > 0, we let -Be(r) := (x G A" : 
llxllr < e} and by Af{T) we denote a neighborhood of T in 
A”. If A, B C A” are two sets, denote by A\B the set-theoretic 
difference of A and B.lf I = {ii,, z„} is an index set, the 
ordered list of elements {xi ^, ■ • ■, is denoted by (xj)j^i. 

Let U, W be finite-dimensional vector spaces. A function 
f : U ^ W is homogeneous if, for all p > 0 and for all 
X GV, f{px) = pf{x). A function f :U xV ^W, f{x,y) 
is homogeneous with respect to x if for all p > 0 and for all 
{x,y) gU xV, f{px,y) = pf{x,y). 

The following stability definitions are taken from ll^ . Let 
E : X = /(x) he a smooth dynamical system with state space 
a Riemannian manifold X. Let xo) denote its local phase 
flow. Let r C A” be a closed set that is positively invariant for 
E, i.e., for all xo G T, (j)(t,xo) G T for all f > 0 for which 
4>{t,xo) is defined. 

Definition 1: The set L is stable for E if for any e > 0, 
there exists a neighborhood AA(r) C X such that, for all 
Xo S A/’(r), fi{t,xo) G ^e(r), for all < > 0 for which 
(j){t,xo) is defined. The set T is attractive for E if there 
exists neighborhood A/'(r) C X such that for all xo G -^(L), 
limt_).oo Xo)||r = 0. The domain of attraction ofT is the 
set {xo G A” : limj^oo Xo)||r = 0}. The set L is globally 
attractive for E if it is attractive with domain of attraction X. 
The set L is locally asymptotically stable (LAS) for E if it 
is stable and attractive. The set T is globally asymptotically 
stable for E if it is stable and globally attractive. A 

Now consider a dynamical system E(fc) : x = /(X; iti 
which fc G R.^ is a vector of constant parameters (typically, 
control gains) and / is a smooth vector field with state space 
a Riemannian manifold. 

Definition 2: The set L is globally practically stable for 
E(fc) if for any 6 > 0, there exists a gain k* such that Bg(r) 
has a subset which is globally asymptotically stable for E(fc*). 
A 

III. Modeling 

We now return to the *-th robot depicted in Ligure [T] with 
the aim of deriving its equations of motion. We fix a right- 
handed orthonormal inertial frame I, common to all robots, 
and attach at the centre of mass of robot i a right-handed 
orthonormal body frame Bi = {bix, biy, biz}, as depicted in the 
figure. We denote by {xi,Vi) the inertial position and velocity 
of robot i. We let g denote the gravity vector in frame I. 

We let Ri be the 3x3 matrix whose columns are the 
coordinate representations of bix,biy,biz (in this order) in 


TABLE I 

Table of Notation 


Quantity 

Description 

TUi, Ji 

mass and inertia matrix of robot i 

Xi £ 

inertial position of robot i 

Vi e R® 

linear velocity of robot i 

Ri e SO (3) 

attitude of robot i 

uJi G 

angular velocity of robot i 

gi = -Ries 

thrust direction vector of robot i 

r® = R~^r 

coord, repr. of r in frame Bi 

Xij — Xj Xi 

rel. displacement of robot j wrt robot i 

Vij = Vj - Vi 

rel. velocity of robot j wrt robot i 

fi G 

reference force of robot i 

U3i G R® 

reference angular velocity of robot i 

Xi 

set of neighbors of robot i 

Vi — 5 ).7'GA/’,; 

vector of rel. pos. and vel. available to robot i 


frame X, so that Ri G SO(3). The unit vector qi := —RiC^, 
depicted in Ligure[T] is referred to as the thrust direction vector 
of robot i, and the matrix Ri is referred to as the attitude of 
the robot. We assume that a thrust force Uigi is applied at the 
centre of mass of robot i. Notice that Uigi has magnitude Ui, 
is directed opposite to biz, and has constant direction in body 
frame Bi. 

Robot i is assumed to have an actuation mechanism that 
induces control torques Tix,Tiy,Tiz about its body axes. We 
let Ti := (xix, Tiy, Tiz) be the torque vector, and uii denote 
the angular velocity of the robot with respect to frame I (the 
unique vector in R^ such that Ri{Ri)~^ = ujf). 

In this paper we adopt the convention that if r G R^ is 
an inertial vector, the coordinate representation of r in frame 
Bi is denoted by r*, that is, r* := R~^r. In particular, the 
angular velocity of robot i in its own body frame is denoted 
by w®. Linally, we use boldface symbols to denote reference 
quantities. Lor instance, is the reference force for vehicle i 
as in (|5]l and is the reference angular velocity for vehicle 
i as in (|9]l. The notation is summarized in Table |I] 

Picking (xi,Vi, Ri,ujl) as state for robot i, we obtain the 
equations of motion 

ii = Vi, 

( 1 ) 

rriiVi = -UiRiCz + nug, 

R^ = R^{u^lr, 

J,ul = n-ulx J^ujI 

In the above, rrii is the mass of robot i and J* = Jj is its 
inertia matrix. We define the (inertial) relative positions and 
velocities as Xij := xj — Xi, Vij := Vj — Vi. This model is 
standard and is widely used in the literature to model flying 
vehicles such as quadrotor helicopters. See, for instance, ED. 
Sometimes researchers use alternative attitude representations, 
prominently quaternions ll2^ or Euler angles ll^ . ll^ . The 
model ([D-@ ignores aerodynamic effects such as drag and 
wind disturbances (such effects are included in ED)- It also 
ignores the dynamics of the actuators. 

IV. Rendezvous Control Problem 
We begin by defining the sensor digraph Q = (V, £), where 
V is a set of nodes labelled as {!,..., n}, each representing a 


-Vx 

0 
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robot, and E is the set of edges. An edge from node i to node 
j indicates that robot i can sense robot j (Q has no self-loops). 
A node is globally reachable if there exists a path from any 
other node to it Q. 

We denote by A/i C V the set of vehicles that robot i can 
sense. In a realistic scenario, A/i is the set of robots within the 
field of view of robot i. For instance, if each robot mounted 
an omnidirectional camera, then one could define A/i to be 
the collection of robots that are within a given distance from 
robot i. With such a definition, the sensor digraph Q would 
be state-dependent, making the stability analysis too hard at 
presenjl 

In light of the above, in this paper we assume that A/i is con¬ 
stant for each i G {1,. ■. ,n} (and hence Q is constant as well). 
If j G Afi, then we say that robot j is a neighbour of robot i. If 
this is the case, then robot i can sense the relative displacement 
and velocity of robot j in its own body frame, i.e., the 
quantities Dehne the vector j/j := The 

relative displacements and velocities available to robot i are 
contained in the vector y® := We also assume 

that robot i can sense its own angular velocity in its own frame 
Bi- To summarize, we have the definition below. 

Definition 3: A local and distributed feedback (ui^Tf) for 
robot i is a locally Lipschitz function of y] and wj. A 

The adjective local indicates that all quantities are repre¬ 
sented in the body frame of robot i, while distributed indicates 
that only relative quantities with respect to neighboring robots 
are accessible. In applications, a local and distributed feedback 
for robot i can be computed with on-board cameras and rate 
gyroscopes. 

We are now ready to define the Rendezvous Control Prob¬ 
lem. 

Rendezvous Control Problem: Consider system and 

define the rendezvous manifold 

r G ^ ^ 50 ( 3 )" x 


Xi' 


= Vij = 0, Vi, j} ■ 


( 3 ) 

Find, if possible, local and distributed feedbacks 
(wi, A)i=i....,n that globally practically stabilize F. A 

The goal of the rendezvous control problem is to achieve 
synchronization of the robot positions and velocities to any 
desired degree of accuracy from any initial configuration. 

V. Solution of the Rendezvous Control Problem 
Definition 4: Consider a collection of n double-integrators 

Xi = 

Vi = fi, i = 1... n, 

where fi is the control input of subsystem i. Suppose the 
double-integrators have the same sensor digraph Q as the 

*For a graph Q, existence of a globally reachable node is equivalent to 
having a directed spanning tree in the reverse graph. 

^Relatively little research has been done on distributed coordination prob¬ 
lems with state-dependent sensor graphs. In this context, in the simplest case 
when the robots are modelled as kinematic integrators, it has been shown 
in 01 that the circumcentre law of Ando et al. ES preserves connectivity 
of the sensor graph and leads to rendezvous if the sensor graph is initially 
connected. Despite the simplicity of the robot model, the stability analysis 
in 01 is hard, and the control law is continuous but not Lipschitz continuous. 


( 4 ) 


underactuated robots of Section Hill A feedback fi(yi), i = 
1... n, is a double-integrator consensus controller if has 
the form 


^ ^ {^ijXij -\- hijVij'^ , i — 1, . . . , 71, 

j&Mi 


( 5 ) 


(6) 


with Qij, bij G K and if, setting fi = fi(yi) in (l4|l, the set 

{{xi,Vi)i^{i,„n} G X R^” : Xij = 0,Vij = 0, Vi,j} 

is globally asymptotically stable for (l4]i. A 

Ren et al. in HI Theorems 4.1, 4.2] and Yu et al. in JS] 
Theorem 1] have shown that a double-integrator consensus 
controller exists if and only if the sensor digraph Q has a 
globally reachable node. Now the main result of this paper. 

Theorem 1: If the sensor digraph Q has a globally reachable 
node, then the rendezvous control problem is solvable for 
system O-dHi, and a solution is given as follows. Let fi, 
i = 1,..., n, be a double-integrator consensus controller. The 
local and distributed feedback, 

Ui=- miftiyl) • 63 , 

Ti =w\ X JiW® - fci Ji ((w- X fi(y-)) X 63 ) 

- klk 2 [w® - fci(fz(y®) X 63 )] , 7 = 1.. .71, 

where ki,k 2 > 0 are control parameters, makes the ren¬ 
dezvous manifold Q globally practically stable. In particular, 
for any e > 0, there exist kfk^ >0 such that for all ki > k^, 
k2 > k*, the set i?£(r) has a globally asymptotically stable 
subset. 

The proof of Theorem [T] is presented in Section IVTl 

Explanation of proposed controller 

Returning to the block diagram of Figure |2] we now explain 
in detail the operation of its two nested loops. We begin with 
the observation that a double-integrator consensus controller 
fiiUi), 7 = 1... 71, for system (|4|i also makes the systems 

Xi = Vi 

( 7 ) 

Vi= fi+9 

rendezvous, since the addition of the gravity vector g does not 
affect the relative dynamics. Now compare system (|7]l to the 
translational dynamics of the flying robots. 


Xi = Vi 


Vi = -—UiR4e3 -G g. 


( 8 ) 


If it were the case that fi = —{l/mfiuiRies, systems (|7]i 
and (Ell would be identical. Then, setting —UiRiCs = rmti 
in (|8]l would solve the rendezvous problem. Inspired by this 
observation, the outer loop of the block diagram in Figure |2] 
assumes that —UiRiCs is the control input of dH) and com¬ 
putes a desired double-integrator force rriiti which becomes 
a reference signal for the inner loop. 

We now explore in more detail the operation of the inner 
loop. First we observe that since is a linear function, we 
have Rifiiyl) = ffiRiyl) = ffiyi). Moreover, using the fact 
that dot products are invariant under rotations, we have 

Ui = -mifi{yl)-e 3 = mi{Riti{yl))-{-Ri 63) = mifi{yi)-gi, 
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where qi is the thrust direction vector. Thus, the thrust 
magnitude is the projection of the desired thrust rriifi onto 
the thrust direction vector—see Figure |3] Now let (^Kul) = 
ki X 63). Then we have 

Ti =u}l X J,ujI - ki.h {{ujI X {,{yl)) x 63) 
-k^k^iujl-cjliyl)). 

We will show in the proof of Theorem [T] that the torque inputs 
Ti make w® converge to an arbitrarily small neighborhood of 
ljI, i = 1,.. . ,n. Thus, can be seen as a reference angular 
velocity for the inner loop. Using the fact that, for all a,b 
and all R G S0(3), R(a x b) = (Ra) x (Rb), we have 

uii = R^u}] = Riki (fi(j/*) X 63) = ki {{Rifi{yl)) x (Ries)) 
= fcl(f*(yi) X -qi) = ki{qi X fi{yi)). 

Thus (jJi is perpendicular to the plane formed by the thrust 
direction vector qi and the desired thrust force rriifi —see 
Figure [3 Since the angular velocity vector identifies an instan¬ 
taneous axis of rotation, it follows that if uji — cJi, then robot i 
rotates about cJi according to the right-hand rule. Referring to 
Figure [3l we see that such a rotation closes the gap between 
Uiqi and rriiti, and the speed of rotation is proportional to 
sin(/3, where (p is the angle between uiqi and rriifi marked 
in the figure. When the gap is closed, we have Ui = ||rriifi||, 
qi = mifi/\\mifi\\, and thus Uiqi = rriifi. In conclusion, the 
inner loop assigns {ui, Ti) to make tOi approximately converge 
to LJi, so that Uiqi = —UiRiCs approximately converges to 
rriifi, which is computed by the outer loop. 

While the intuition behind the proposed controller is simple, 
the proof that the interplay between the two nested loop results 
in global practical stability of the rendezvous manifold is 
rather delicate, and it crucially relies on the homogeneity of 
the functions f^, i = 1,..., n. 

Remark 1: Theorem [T] proves global practical stability of 
the rendezvous manifold F. The reason that the stability is 
practical and not asymptotic is roughly as follows. In order 
to achieve rendezvous of the rigid bodies, Uiqi is driven 
approximately to rriifi. What’s important is not so much 
the difference in magnitude of these vectors but rather the 
difference in angle between them. In Figure 3, one can see 
that cJi acts to reduce this angle with a rate proportional to 
the magnitude of cJi. Since cJi is a linear function of f^, as the 
robots approach consensus cJi converges to zero at the same 
rate as f^. This leads to increasing inaccuracy in closing the 
gap between the vectors Uiqi and rriifi insomuch that in a very 
small neighborhood of rendezvous, uii is so small that it fails 
to make the translational dynamics act as double integrators. 
More detailed reasoning is provided in Remark |2] 

Features of the proposed controller 

(i) The proposed controller has a number of advantages 
over our previous work in Il29l . Unlike Il29l . the inner control 
loop does not require any derivatives of the reference thrust 
force fi. In 1291 . the large expressions resulting from such 
derivatives pose difficulty in real-time computation of the 



Fig. 3. Illustration of the control input ui and reference angular velocity lji 
in (6). 

control law. More importantly, the computation of such deriva¬ 
tives requires communication between neighboring robots, a 
problem that has been overcome in the present approach. The 
approach in ll29l requires that robots have access to a common 
inertial vector. This requirement is absent in this paper. 

(ii) The feedback of Theorem [T] is static. It does not 
depend on dynamic compensators that require communication 
between neighboring robots. 

(iii) The feedback of Theorem [T] is local and distributed 
in the sense of Definition [3] Interestingly, it does not require 
sensing of relative attitudes, which can be computed using 
on-board cameras, but are harder to compute than relative 
displacements. 

(iv) On the rendezvous manifold F there is no prespecified 
thrust direction qi for robot i and the robot thrust directions do 
not need to align at rendezvous. This is desirable if one wants 
to employ the proposed controller in a hierarchical control 
setting to enforce additional control specifications. 

VI. Proof of Theorem[T] 

The feedback in (|6]l is local and distributed because it is 
a smooth function of y) and oj\ only. By Theorems 4.1 and 
4.2 in H] (or Theorem 1 in 121), if Q has a globally reachable 
node then there exists a double-integrator consensus controller, 
and the feedback (|6l) is well-defined. We need to show that it 
renders the rendezvous manifold F in Q globally practically 
stable. We begin by expressing the translational portion of the 
dynamics in coordinates relative to robot 1, i.e., in terms of 
the variables {xij,vij)j^ 2 ,...,n, 

Xij — '^Ij t 

Vrj — RjGi^Uj -f RrCi^ui, j 2,... ,ri, 
rrij mi 

R, = Ri(uj))^, 

. ■ . (11) 

JiU^i — Ti U^i X JitUi , % — 1 , . . . , 71 . 

Since all relative states {xij,Vij) can be expressed in terms of 
the variables above through the identity {xij,Vij) = (xy — 
xu,vij — vii), perfect rendezvous occurs if and only if the 
vector {xij,vij)j- 2 ,...,n is zero. Denoting, 

X := (Xi„Ui,)i=2.....n e X := R3("-1) x 
R := e R:=S0(3)", 

a;:= (cc^, ...,<)£ Q := 

the new collective state is {X,R,ijj) G X x R x Q. The 
meaning of the new state is this: X contains all translational 


6 


states (positions and velocities) relative to robot 1, R contains 
all the attitudes, and w contains all body frame angular 
velocities. The rendezvous manifold in new coordinates is the 
set {{X,R,oj) gXxRxQ:X = 0}. 

Due to the identity (xy,Uy) = {xij — Xii,vij — vu), 
the vector = {xij is a linear function of X 
which we will denote yi = hi{X). Similarly, the vector 
yl = {xlj,vlj)j^j\f^ is a function of X and R, linear with 
respect to X. We will denote this function y* = h\{X,R). 
Using the definitions above, we may now express f*(y*) and 
^ ^ 3 ) (the latter function was discussed 
in Section |V]i in terms of states. Accordingly, we define : 
X —>• g® : X X R —7> and a; : X x R —>• Q as follows: 

g,{X) :=f,o/i,(X), 

gliX, R) := R-^g,iX) = f, o h^iX, R), (12) 

cjiX,R) := {LJ,{hliX,R))).^^_^. 

We remark that gi is linear and g* is linear with respect to its 
first argument. The second identity in the definition of g* is 
due to the linearity of f^. 

Finally, we define the rendezvous manifold in new coordi¬ 
nates, 

r* :={{X,R,uj)gXxRxQ: X = 0}. (13) 

We will prove that F* is globally practically stable, which will 
imply that F is globally practically stable as well. 

A. Lyapunov function 

Consider the n double-integrators (|4|i with control in (|5]l, 
expressed in X coordinates: 

iij = vij 

-fi(2/i) =gj(^)-gi(^), j = 2,...,n. 

(14) 

By Definition |4] the origin of this linear time-invariant system 
is globally asymptotically stable. Thus, there exists a quadratic 
Lyapunov function V : X —R, V{X) = X^PX, where P is 
a symmetric positive definite matrix, such that the derivative 
of V along the vector field in (fT4l i is negative definite. 

Let J G be the block-diagonal matrix with the i-th 

block equal to Ji, and consider the function W : X x R x f2 — 
R defined as 

W{X,R,u;)=aWtr,niX) + W,otiX,R,io), (15) 
where a > 0 is a parameter to be assigned later and 

W,UX) = VviX) + ^ViX), 

n 

Wrot{X,R,uj)=Y,sUX,R)-e3 

+ R)). 

Lemma 1: Consider the continuous function W defined 
in (fTSl) . Then 

a* := sup V \gliX/y'V{X),R) ■ 63 ] < 00 , 
(jf.fi)ex\{o}xR j 



Fig. 4. Illustration of the sets Si and Sp. 


and for all a > a*, the following properties hold: 

(i) VF > 0 and W-^{Q) C F*. 

(ii) For all c > 0, the sublevel set Wc := {(X,R,uj) : 
W(X, R,uj) < c} is compact. 

(iii) For all e > 0, there exists (5 > 0 such that Ws C 
The proof is in the appendix. 

From now on we assume a > a*. In light of the lemma, if 
we show that W is nonincreasing outside a certain compact 
region of the state space, then all trajectories of (fT0l) - (fTT]) 
with feedback (|6l) are bounded, ruling out finite escape times. 
Moreover, in light of part (iii) of the lemma, to prove that 
F* is practically stable it suffices to prove that for every 
i5 > 0, there exists a gain vector {ki,k 2 ) such that Wg is 
globally asymptotically stable. For this, we need to show that 
W>S W <0. 

B. Coordinate transformation 

We now construct a coordinate transformation on the trans¬ 
lational states X that leverages the homogeneity property 
of fi. Return to the Lyapunov function V{X) — X^PX 
associated with the double-integrator consensus controller. 
Since U is a positive definite quadratic form, its level sets 
are compact and convex. Consider the level set Si := {X G 
X : vlx) = X^PX = 1 }, and for p > 0, let Sp 
denote the set Sp := {X G X : X = p9,9 G S'!}. The 
sets Si and Sp are depicted in Figure |4] By convexity of 
Si, any point X G X\{0}, can be uniquely represented as 
X = p9, p G R+, 9 G Si, where p = V X^PX and 
9 = X/p. In the above decomposition, one can think of p as a 
scaling factor determining the size of the neighborhood of zero 
where X belongs, while 0 is a shape variable determining the 
relative positions and velocities of the robots modulo scaling. 
We use this construction to transform the coordinates of the 
relative translational states in X as follows. Define the map 

F : X\{0} X R X R+ x x R x Q, 

F{X, R, a;) = (p, 9, R, a;), p := ^V{X), 9 := X/^V{X). 

Clearly is a smooth bijection. Moreover its inverse 
9^ R, Lo) = {p6^ uj) is smooth as well, so F is a dif- 
feomorphisnll. The new state is (p, F, oj) G IR.+ x 5i x R x Q. 

is a diffeomorphism of smooth manifolds. The set is diffeomorphic 
to the unit sphere of dimension 6(n — 1) — 1. All other sets involved in the 
Cartesian products ai‘e smooth manifolds 
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Rendezvous in these coordinates would correspond to having 
p = 0, which is outside of the image of F. This is not a 
problem though, since we want to show practical stability of 
the rendezvous manifold, for which it suffices to show that p 
can be made arbitrarily small. 

Having defined a coordinate transformation, our next objec¬ 
tive is to represent the Lyapunov function candidate W in new 
coordinates. The new representation is W = W o F~^, which 
amounts to simply replacing X by p9. Doing so we obtain 

Wip,0,R,u;)= alTtran ip) + l^rot {p,0,R,uj), 
where TTtran(p) = p + 


Wrot (p,9,R,Uj) =pY^ g* (6», i?) • 63 

+ i (^ _ (Jj{p9, R)y]l (w - Lj{p9, R)). 


In writing the above, we used the identity p = \JV (x) and 
the fact that the function gi(X, i?) is linear with respect to X, 
implying that gl{p9,R) — pgl{9,R). In what follows, we let 
Ws := l{p,9,R,u;) e R+ x S'! x R x Q : Wip,9,R,uj) < S}. 
Thus, Ws = F{Ws). 


C. Stability analysis 

Let 5 > 0 be arbitrary. We have W < a{p + p^/ 2 ) + 
P^^P( 9 M) ^) • esi + (l/2)(a;-4 J). Using the 

definition of a* in Lemma [T] and the fact that a > a*, we get 

W < a(2p + pV 2) + (l/2)(a; - - cj). 

It readily follows that there exists g G (0,1) such that 

Ag := {(p, 9,R,uj): pG (0, p), ||a;-t.;(p6i, < p} C Ws- 

We will show that there exist a > 0 and a gain vector {ki, ^ 2 ) 
such that VL < 0 outside the set Ag. This will imply that W > 
S => IT < 0, proving that Ws is globally asymptotically 
stable. 

Lemma 2: Consider the closed-loop system (fTOb- lfTTI) with 
feedback Q. If ki > 1, then there exist scalars Mi,..., M 4 > 
0 such that the derivatives of p and Wrot along the closed- 
loop system in (p, 9, R, oj) coordinates satisfy the following 
inequalities: 


P <P 


-M2 + MiY,\\sl{0,R)xe3\\ 


2=1 


(16) 


l^rot<p"^[-Al||gK^,^)xe3|| 

2=1 

M 4 ] k‘fk2. 


+ pMs-‘^\\Lo-u:{p9,R)\\\ 


From now on we let ki > 1. Using the inequalities in 
Lemma 12] we get 


W <(p- 




-aM2 -f aMi ^ ||g*x 631| 
Mi 


2=1 


-ki\\sli9,R)xe,r + 
klk 


+ pM:i-yM\\u-i^{p9,R)r. 

Denote ^^{9,R) := \\q\{9,R) x 63 !!, and (3{9,R) := 
{l3i{9,R),..., (3^{9,R)). For notational convenience, we 
omit the arguments of the functions (3 and lj. With these 
definitions, the inequality above may be rewritten as 

Min\ 

~) 


W <(p + p2) (-aM2 + aMil^/3) +p2 (-fci||/3|| 
-I-PM 3 - -a;|p. 


For every k 2 > nMi/M^, we have 

1 ^ <(p + P^) {-aM2 -I- M 3 -I- aMil^/3) - p^fci||/3|p 

^1^2 II ||2 

If we further pick a > max{a*, 3 M 3 /M 2 }, we have 
1 ^ <{p + P^) (- 2 M 3 + aMil^/3) - p2fci||/3f 

,, 1,9 

Splitting the term —p^fci||/3|p into two parts and collecting 
terms for p and p^, we obtain 

ik <p2 (^-2M3 + aMil^j3 - 

+ p (^-2M3 + aMilT/3 - p^||/3f 

r^l r\.2 II II 2 

- ^llw-£*^ir. 

Consider now the expression 

M3-aMilT^+^||/3f=[lT / 3 T] 

If ki > 2n{aMi/2 )‘^/{qM^), the above quadratic form is 
positive definite, implying that 


Ms j 
n 


1 

[-a^I 

kig T 

2 ^ J 

P. 


M3-aMil^/3+^||/3f > 0 . 


(17) 


Since p < 1, we also have M 3 —aMil^/3-|-(fci/2)||/3|p > 0. 
Using the latter inequality, we get a further upper bound for 
W, 

VF < - p2M3 + p (- 2 M 3 + aMil^/3 - py ||/3||‘ 


^ 1^2 II ||2 


(18) 


\UJ-U}\\ 


Using (fTsT l. we now prove that outside Ag, lU < 0. In other 
words, when either p > p or ||a; — a;|p > p, W <0. 


The proof is in the appendix. 






















TABLE II 

Simulation Initial Conditions 


TABLE III 
Control Effort 


Vehicle i 

Xi(0) (m) 

Vi(0) (m/s) 

Ri(0) 

1 

(0,-10,10) 

(0,0,0) 

side 1 

2 

(0,10,10) 

(0,0,0) 

side 2 

3 

(0,0,0) 

(0,0,0) 

down 

4 

(-10,0, -10) 

(0,0,0) 

up 

5 

(10,0,-10) 

(0,0,0) 

up 



Figure 

Figure jTJ 

maxi supj \ui(t}\ (N) 

20.4 

17.21 

maxisupt i|Ti(t)|| (N-m) 

15.27 

16.47 

maxi rms(|iii(t)|) (N) 

1.72 

4.31 

maxi rms(j|Ti(t)||) (N-m) 

1.43 

2.24 


Remark 2: If the derivative W were negative definite, then 
the rendezvous manifold F* would be globally asymptotically 
stable. However, this is not guaranteed in (fTsT l. The reason 
is as follows. Suppose p is very small and ||a; — a>|| = 0. 
Then all terms multiplied by become negligible and what 
remains in ( fTSl l is, IF < p (— 2 M 3 + As we have 

no control over the value of the constants Mi and M 3 in the 
equation above, W can be greater than zero if the second term 
dominates the first. 

Suppose first that p > Q- Then from (fTSl) we have 


li^ < - p^Mn + p (^-2M3 + aMil^/3 - ^\\I3\\ 

kik2 II ||2 

-i— w -a; r. 


By inequality (fTTl i we conclude that 

k\k 2 


W A —p M 3 — PM 3 — 


iw-oiir < 0. 


Next, suppose that ||w — w|P > §■ Then from ( fTSl ), 


; L 

W < -p^M3 + paMilT/3 - -l^Q 

< -p^M3 + paMiMs - 

where M 5 := max(g-R)}- The maximum 
exists because /3 is continuous and x R is a compact set. 
If k 2 > {aMiM^/kiY/Q then IF < 0. 

We have therefore proved that, if a > max{a*, 3 M 3 /M 2 }, 
ki > max{l, 2 n(aMi/ 2 )^/(pM 3 )}, and ^2 > 

max{nM 4 /M 3 , (aMiMs/fcij^/p}, then W > 6 implies that 
IF < 0. Therefore, for any initial condition, the solution 
of (fT 0 l i- (fTTl i with feedback (| 6 ]l is bounded and the set Ws is 
globally asymptotically stable. □ 


VII. Simulation Results 

We consider a group of five robots with the sensor digraph in 
Figure |5] The robot masses and inertia matrices are: mi = 3 
Kg, m 2 = 3 Kg, m 3 = 3.4 Kg, 1714 = 3.2 Kg, m 3 = 3.2 
Kg and Ji := diag (0.13, 0.13, 0.04) Kg-m^, as in ll28l . J 2 = 
Ji, J 3 = 1.4Ji, J 4 = 1.2Ji, J 5 = 1.2Ji. We use the 
double-integrator consensus controller of Ren and Atkins |[T1, 
ftiUi) = +jVij) where aij >0, 7 > 0. It is 

shown in IT] that for sufficiently large 7 the above controller 
does indeed achieve consensus. We pick = 0.3 for all 
j G Afi and 7 = 30. The control gains ki and ^2 in (| 6 ]l are 



Fig. 5. Sensor digraph used in the simulation results. 


chosen to he ki — 2 and ^2 = 0.45. The initial conditions of 
the robots are shown in Table |II] The initial attitudes Ri (0) 
of the robots are: up(right), side(ways) 1 , side(ways) 2 and 
(upside)down respectively given by: 


'l 

0 

o' 


'1 

0 

0 ■ 


'1 

0 

o' 


'1 

0 

0 ■ 

0 

1 

0 

5 

0 

0 

-1 

5 

0 

0 

1 

5 

0 

-1 

0 

0 

0 

1 


0 

1 

0 


0 

-1 

0 


0 

0 

-1 


Figure | 6 ] shows the simulation without the presence of distur¬ 
bances while Figure |7] shows the simulation when disturbances 
are present. The disturbances are: an additive random noise 
with maximum magnitude of 0.25N on the applied force; an 
additive random noise with maximum magnitude of 0.25 N-m 
on the applied torque; an additive measurement error for the 
angular velocity, with maximum magnitude of 0.25 rad/s; an 
additive random noise on the quantity fi{yl) accounting for 
errors in measurements of relative displacements and velocities 
of the vehicles. The direction of this vector has been rotated 
within 0.25 rad and the magnitude is scaled between 0.75 to 
1.25 times the actual magnitude. The disturbances are updated 
10 times per second. In both cases of Figure | 6 ] and Figure|2l the 
vehicles’ positions and velocities converge to a neighborhood 
of one another. 

In Figure | 6 ] the vehicles remain within 0.25m of one another 
while in Figure|2]the vehicles remain within Im of one another 
at steady state. These neighborhoods can be made even smaller 
by further increasing the control gains fci and k 2 . However, this 
would result in having higher control inputs. Metrics related 
to the thrust and torque inputs are presented in Table HII] The 
first two rows show peak control norms and the last two show 
the root mean square (rms) of the control norms. In these 
simulations we considered zero gravity, i.e., p = 0. This was 
done to improve visibility of the simulation results. In the 
presence of gravity, the vehicles would still converge to the 
same neighborhood of one another, however at steady state 
they would accelerate in the direction of gravity since gravity 
is not compensated through the control inputs in (| 6 ll. 
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Fig. 6. Rendezvous control simulation without the presence of disturbances. 
At the top-left, top-right and bottom-left: positions of the five robots expressed 
in the inertial frame X. At the bottom-right: linear speeds ||ui||, i = 1,..., 5. 




1.5 



0 50 100 150 200 

time (s) 


Fig. 7. Rendezvous control simulation with the presence of disturbances. At 
the top-left, top-right and bottom-left: positions of the five robots expressed 
in the inertial frame X. At the bottom-right: linear speeds ||i'i ||, i = 1,..., 5. 


VIII. Conclusions 

We have presented the first local and distributed feedback 
solving the rendezvous control problem for a class of un¬ 
deractuated robots modelling vertical take-off and landing 
(VTOL) vehicles such as quadrotor helicopters. The main 
result. Theorem [T] relies on the assumption that the sensor 
digraph is constant. As we have discussed in the paper, 
this assumption is questionable in practice, but a stability 
analysis in the presence of a state-dependent sensor digraph 
is beyond the scope of this paper. We believe that solutions 
in the literature for consensus of double-integrators with time- 
dependent sensor digraphs could be extended to rigid bodies 
using the framework in this paper. However the Lyapunov 
function used in the analysis would need to be modified 
extensively. Since this makes the problem even more difficult 
than it already is, we leave it as a possible future research 
direction. In this paper we limited ourselves to the control 
specification of rendezvous. The proposed control law, in 
particular, does not guarantee hovering of the vehicles. While 
the robots converge to each other, nothing can be said about 
the motion of the ensemble. This cannot be otherwise, for it 
would be impossible to solve the rendezvous problem with 


hovering without additional sensors. One would need some 
measurement of the gravity vector, for example provided by 
a three-axis accelerometer. The point of view of these authors 
is that the proposed solution of the rendezvous problem 
will serve as a layer in a hierarchy of higher-level control 
specifications such as hovering, formation stabilization, and 
path following. 


Appendix 

A. Proof of Lemma |7] 

Recall the definition of W{X, R,oj), and assume that X fQ, 
W=a (^y/v(Jn + ^V(X)^ +^g,l(X,i?).e3 
+ ^(u;-u:(X,R))^^(u;-c^(X,R)) 

+ i(a; - u^(X, R))^I(u; - u:(X, R)). 

Since g* {X, R) is linear with respect to X, we have 

=yy(X) ^gK/r(X), i?) • 63 ^ + 

+ i(a; - (v(X, R)yi(u; -u:(X, R)), 

where /r(X) := Xjy^V{X) is continuous on X\{0} and 
bounded as follows 

||,(X)||= W , ll^< 1 ^ 

XHX) VX^PX 

Since g® is continuous, ii{X) is bounded, and i? € R, a com¬ 
pact set, it follows that the function YX=i |Si R) ' S 3 \ 

has a bounded supremum. Accordingly, let 

n 

a* = sup '^\sl{n{X),R) ■ es] . 
(X,fl)gX\{ 0 }xR 

For all a > a*, we have W{X,R,uj) > W(X, R.uj), 
WiX,R,uj) 

-h ^{oj-u:{X,R)yi{uj-u}{X,R)) > 0. 

We derived the bound above for X 0, but since g®(0, i?) = 0 
(by linearity of g® with respect to X), the bound also holds 
for X = 0. The above inequality implies that W > 0 and 
W-^{0) C But IT = 0 if and only if V{X) = 0 

(i.e., X = 0) and oj — lj. Thus 1T“^(0) C T*, proving part 
(i) of the lemma. 

For part (ii), note that for all c > 0, Wc C {W_ < c}. 
Since IT is a positive definite quadratic form in the variables 
{X,uj — w), its sublevel sets are compact in {X,uj — u>) 
coordinates. Thus if {X,R,u)) G ITc, X and w — ijj{X,R) 
are bounded. Since w is continuous and R G R, a compact 
set, LJ is bounded, implying that ui is also bounded. Therefore 
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the set Wc is bounded. Continuity of W implies that Wc is 
compact. This concludes the proof of part (ii) of the lemma. 

For part (iii), let e > 0 be arbitrary. Since W is a 
positive definite quadratic form in the variables {X,uj — cj), 
there exists (5 > 0 such that W_{X, R,uj) < 6 implies 
\\{X,uj-u){X,R))\\<e. 

Furthermore, the inequality ||(X,w — u;(X,i?))|| < e 
implies that ||X|| < e. Now consider any point {X,R,uj) G 
i W < ( 5 }. We have just seen that this implies that ||X|| < e. 
It will be shown next that this implies {X,R,uj) G Bg(r*) 
and hence < i 5 } C Be(T*). 

Note that {X, R, oj) G X x R x Q lies on the product of metric 
spaces X, R and Q. Respectively, the metrics are dx, dp and 
dn (dx and do are Euclidean metrics). As such, choosing to 
use the 2-product metric, 

= inf [dx{X, Xq)'^ + cIr^R, Rq)'^ + . 

(Xo,i?oi^o)^r* 

Recall that F* = {(X, i?, w) G X x R x Q : X = 0 }. As such, 
the point ( 0 , R, uj) is contained in the set F* and therefore, 

||(X,i?,a;)||r* < (dx(X, 0 )^ + dR(i?, + do(w, a;)^) ^ 

where dR{R,R) and do(w,a;) are zero. This yields, 
||(X, i?, a;)||r* < dx(X, 0 ) < ||X|| < e. This implies that 
(X,i?,w) G B.iT*). Thus, Ws C {W< 6 } C B,(r*), as 
required. This concludes the proof of Lemma [U □ 


The first term in the bracket is the derivative of T^(X) along 
the nominal vector field Gil, and Q = is a positive 
definite matrix. Letting M2 = Amin(( 5 )/( 2 Amax(^’)) and 
using the fact that the Euclidean norm is invariant under 
rotations, we have 


1 




E 

Lj=2 


dV 


(||(g^:(X,i?).e3)e3-g^:(X,i?)|| 


dvij 

+ ||(g}(X,i?). 63)63-g}(X,i?)||) 


We claim that || (g)(X, i?) • 63)63-g)(X, i?)|| = ||g)(X,i?) x 
63II. Indeed, writing g) = (g*-e3)63+g)-(g*-63)e3, we have 
SiXea = (gi-(gGe3)e3)x63. Since the vector g*-(g) -63)63 
is perpendicular to 63, ||(g) - (g) • 63)63) x 63II = ||g) - (g) • 
63)63!!, so that !!g) X 63!! = !|g) - (g) • 63)63!!. This proves 
the claim. Using the identity just derived, we get 


dt 


VV{X)<-M 2 ^V{X) 


+ 


E 

i=2 


+!!gi(-^)-R) X 63 


dV 


dv 


U 


g(:(x,i?) X 63!| 


B. Proof of Lemma \ 2 \ 

We will use a standard result from differential geometry 
relating the Lie derivatives of smooth functions along F- 
related vector fields ll 3 ^ Proposition 8 . 16 ]. In our context, 
recalling that p = \/V\x=pe and W = W\x=pe, the result 
has the following implication: 




and Wrot = 

x=p0 dt 

Rewrite the dynamics of X in GOl l as 


x=pe 


( 19 ) 


a;ij — vij 

vij =[gj( 9 f) -1 


l(^)] 


+ dij 
+ Ri 


(gj(X,i?)-63)63-gj(X,i?) 


[(g)(x,i?)-63)63-g}(x,i?);. 

To get the identities above, we added and subtracted in GOl l the 
ideal force feedbacks (jiuj) = Sj{X) and fi(2/i) = gi(X), 
and we replaced Uj and ui in GOl) by the assigned feedbacks 
in (H. Linally, we used the identity Rjg,] = gi. 

Taking the time derivative of \JV (X) along the above 
vector field we get 




-X^QX 


dV 


i =2 


ij 


+ E ^) • ^3)63 - (X, R 


dV 


- E • e3)e3-g}(X, R)) 


i =2 


ij 


Using G 9 ] l. we get 
p < -M 2 P+-^ 

2 p 


E 

i=2 


dV 


(po) 


dvij 

+\\s\ipd,R) X 63!!) 


(!!gj(p0,i?)X63!| 


Since the functions g) are linear with respect to their first 
argument, and the partial derivatives of the quadratic form V 
are linear functions, by the homogeneity of the norm we have 


p < -M2P + I 


E 

i =2 


dV 


dv 


U 


id) 


(!!g^:( 0 ,i?)xe 3 !| 


+ !!g}( 0 ,i?)xe 3 !|) 


The functions !!£)U/ 9 vij!! are continuous. The variable 9 
belongs to Si, a compact set. Therefore !!c)U/ 9 t;ij!| has a 
maximum. 


p < — M2P + max 

oesi 


dV 


dv 


U 


id) 


n 

^(!!gj(0,i?)xe3!!) 


Lj =2 


+ {'n-l)\\gl{ 9 ,R) X 63 ! 



. 


dV 

< —M2P + max 

eesi 

dvij 

J ie{2,...,rt} 
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Letting Mi := max ||9y/(9t;ij|l (n — l)/2, we get 

the first inequality in (II 6 I 1 . 

We now turn to the second inequality in (fThl l. Recall the 
definition of Wrot, 

n 

W,oi{X,R,uj)=Y,Sl{X,R)-e3 

+ - c.;(X, i?))Tj(a; - a;(X, R)). 

The time derivative of Wrot along the vector field in (fTOll- dTTt 
is 

(|g^) •e 3 + K-a;KX,i?)). 

(^i - UJ\ X JiUjl - J, ^ ■ 

To express {d/dt)gl, recall that g-(X, i?) = R~^{i{hi{X)). 
Then, 

The function fi{hi{X)) is linear. Its derivative along the vector 
field (fTOl i- (fTn i with feedback (| 6 ll is a function of (X, R) which 
is linear with respect to X because Ui = —gl{X, R)-e^ is such. 
We will denote it hi(X, i?), hi(X, i?) := {d/dt)fi{hi{X)). 
Consistently with our notational convention in Table H] we 
will let R) := R~^h.^{X, R). The function R) is 
linear with respect to X. Returning to the derivative of g®, we 
have 

= -{wt)^R-%{h.{X)) + R-^\y,{X,R) 

= -a;®xg®(X,i?)+hKX,i?). 

Similarly, since u}\{X,R) = fci(g-(X, i?) x 63 ), we have 
= ki {—ujI X g® + h®) X 63. Substituting the above 
identities in the expression for Wr-ot and since ti = uj] x 
J^ujI - kiJ,((ujl X g®) X 63) - klk2{ujl - 1*;®), we get 

n 

Wrot = ^ eD • 63 + 63 

-kiicvl - cjD ■ J,(h® X 63) - kfk^lH - a;®f ] . 

Using the property of the triple product that K X si) ■ 63 = 
isl X 63 ) • w®, we obtain 

n 

W^ot=^[-(g*xe 3 )-cu®+h®.e 3 

-AiK - a;®) . J,(h® X 63) - klk^U - a;®f ] . 

Adding and subtracting the term (g® x 63 ) - a;® and collecting 
the term w® — tJ®, we have 

n 

[ - (g- X 63) • CL>® + 63 - ((g- X 63) 

+ kiUK X 63)) • (CU® - a;®) - klk^M - a;®f ]. 


= E 

i=l 


Substituting in the first term inside the bracket w® = — fci(g® x 
63), taking norms, and using the fact that ki > 1, we arrive 
at the inequality 

n 

Wrot<Y.[-ki\\glxesf + \\hle,\\ 

2^1 

+ kik^iX, i?)||cu® - a;®|| - fc^fc^llcu® - a;®f ], 

where k,(X,i?) := ||g®(X,i?) x 63 II + |1 J*(h®(X, i?) x 63 )||. 
Note that {X, R) is homogeneous with respect to X because 
g® and hi are linear with respect to X and the norm is a 
homogeneous function. 

Splitting the term — ^ 2 11 wj —u>\\ \ ^ into two parts and notic¬ 

ing that the function fciki(X, i?)||a;® — Ci;®|| — (fcf fc 2 / 2 )||a;® — 
a;®p is quadratic in the variable ||a;® — t^iH with maximum 
k|(^,i?)/( 2 fc 2 ), we get 


VUrot < V 


2 = 1 ^ 


-fcl||gzX63f -h||h^63||- 


klk2 




i\\2 


. ^liX,R) 

2k2 

Now using ( fT^ we get 




-fci||g®(p0,i?)x63f+ ||hKp0,i?)-e3|| 


2 = 1 

^2 




Using the homogeneity with respect to X of ||g® x 63 1|, ||h® • 
631 |, and ki, we get 


^rot 

2=1 


-kip^\\gl{9,R)xe3f + p\\hl{e,R)-e3\\ 



(jJ 


i\\2 


kf^- 

2k2 


Since ||h®(0, i?) • 63 !! and k^( 6 >,i?) are continuous functions 
over the compact set Si x R, they each have a maximum. 
Letting M3 = n • maX(e,B)gs^,<R(||h®(0, i?) • 63II), M4 = 

2G{l,...,n} 

maxta.Rigs.xR P'^z’ J , we conclude that 


VLrot <P^Yr 

2=1 

klk2 


-ki\\gl{0,R)xe,r + ^ 

k2 


■ pM^ 




2=1 


as 


required. This concludes the proof of Lemma ID 


□ 
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